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Abstract 

Recently there has been considerable interest in efficient formulations of manipulator dynamics, mostly 
due to the desiiability of real-time control or analysis of physical devices using modest computers. The 
inefficiency of the classical Lagrangian formulation is well known, and this has led researchers to seek al¬ 
ternative methods. Several authors have developed a highly efficient formulation of manipulator dynamics 
based on the Newton Ruler equations, and there may be some confusion as to the source of this efficiency. 
1 his paper shows that them is in tact no fundamental difference in computational cfficiencv between 
Lagiangiau and Newton-Eulcr formulations. I he efficiency of the above-mentioned Newton-Ruler for¬ 
mulation is duo to two factois: the recursive structure oi the computation and the representation chosen 
for the rotational dynamics. Both of these factors can be achieved in the Lagrangian formulation, resulting 
in an. algoiitnm identical to die Newton-Ruler formulation. Recursive Lagrangian dynamics has been dis¬ 
cussed previously by Hollerbach. This paper takes the final step by comparing in detail the representations 
that have been used for rotational dynamics and showing that with a proper choice of representation the 
Lagtangian foimulation is indeed equivalent to the Nowton Sailer formulation. 


1 his icpoit describes icseaich done at the Aitificiai Intelligence Laboratory of the Massachusetts Institute 
of technology, ouppoit lot too Laboratorys artificial intelligence research is provided in part by the 
Office of Naval Research under Office of Naval Research contract N00014-77C-0389. 
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1. Background 


Manipulator dynamics concerns the relationship between the motion of a mechanical kinematic chain of 
linkages and the forces applied by its actuators. For some problems, such as simulation, the forces are 
known and it is desired to compute the resulting motion. In other cases, such as the important area of 
real-time control, the desired motion is known and the forces necessary to achieve that motion must be 
computed, in either case, for a given model of a kinematic chain an exact solution can be found, within 
the framework of Newtonian mechanics. The former case reduces to a system of non-linear second order 
differential equations, which can be solved numerically. The latter case is easier—the required forces can 
be expressed directly in terms of the known posi tion, velocity and acceleration of the chain. 

In this paper we restrict the discussion to open-loop kinematic chains, composed of rigid links con¬ 
nected by joints that allow relative motion of the links. We assume that each joint has only one degree 
of freedom, either rotational or translational. Multiple rotational degrees of freedom can be modelled by 
links of zero mass and length. 


1.1 Lagrangian Generalized Coordinates 


In Newton’s original formulation of mechanics, the relationship between forces acting on bodies and 
the resulting accelerations is described using cartesian coordinate systems. There are other, equivalent 
ways to describe the dynamics of a system of bodies. Otic such method was invented by Lagrange, using 
what are known as generalized coordinates. Generalized coordinates arc any convenient set of variables 
that completely define the position of a system of bodies. The Lagrange equation 
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±( < 3L\_<9L 

dt\dqi) <%• 


(ii) 


describes the relationship between tire corresponding generalized forces acting on the bodies and the 
kinetic and potential energy of the system. Here q t is a generalized coordinate, r, is the corresponding 
generalized force, and the dot indicates differentiation with respect to time. L is the Lagrangian—the 
difference between the total kinetic energy and the total potential energy of the system: L = K — P. 


While the Lagrange equation must yield the same numerical results as direct application of Newton’s 


laws, either approach may be more convenient than the other in a given situation, or may provide greater 


insight into the physics of the problem. 


1.2 The Uicker/Kahn Formulation 


A kinematic chain has a natural set of coordinates that completely specify its position—the joint 
variables r/ ( (angles for rotational joints and distances for sliding joints). The q L satisfy the requirements 
for generalized coordinates. Furthermore, they can be measured directly by the manipulator and the 
corresponding generalized forces (torques for rotational joints and ordinary force for sliding joints) are 
just what can be controlled. It is not surprising, then, that the pioneering work of Uickcr [1] and Kahn [2] 
on the dynamics of mechanical linkages made use of the Lagrangian method. 


From the standpoint of the present discussion, the important feature of the work of Uickcr and 

0 

Kahn is their use of 4 X 4 rotation/translation matricies W. t to represent the position and motion of the 
kinematic chain. A coordinate system is attached to and moves with each link. The matrix W t transforms 
the components of a vector with respect to link i coordinates to its components with respect to a fixed 
(inertial) coordinate system. The position and motion of the chain is described by the ITfs and their time 
derivatives, which are in turn functions of the s and their time derivatives. 


Once the kinetic and potential energy of the chain is expressed in terms of the W- s and their deriva¬ 
tives, it is a straightforward matter to apply the Lagrange equation and find the generalized forces. The 
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result looks like 


n 


Ti 


^ , dWj 

g i <• 


( 1 . 2 ) 


where r* is the generalized force applied to the ith joint, Jj is the 4x4 inertia matrix of the jth link in 
that link’s coordinates, and tr is the trace operation. The gravity term is omitted here because it is not 
important for this paper, although in general it must of course be included. 

It has been observed by many authors that evaluating (1.2) directly as written requires time propor¬ 
tional to the fourth power of the number of links. I loilcrbach [3] has determined that for 6 links well over 
100,000 adds and multiplies would be needed to compute all of the r*’ s, and Lull ct al. [4] report that 
a Fortran program running on a PDP-11/45 took nearly 8 seconds to compute them. Since a real-time 
control system would have to repeat tliis calculation at a rate on the order of 60 Hz, until recently it had 
been believed that a manipulator could not be controlled by direct real-time calculation of the actuator 
forces, without introducing approximations or using lookup tables. 

The inefficiency of the original Uicker/Kahn formulation, as well as other reasons, have led research¬ 
ers to look for alternative formulations of manipulator dynamics. The most successful of these has been 
the Newton-Euler approach. 


1.3 The Newton-Euler Approach 


In order to apply Newton’s laws to objects which are not point masses, we consider such objects to 
be composed of a large number of point masses bound together by effectively infinite internal forces. The 
laws governing these so-called “rigid bodies” may be derived from Newtonian mechanics [5], The key 
feature is that the description of motion is broken up into two independent components—linear motion 
of the center of mass (or other suitable point) and rotation of the body about that point. The total vector 
force acting on the body is related to die acceleration of die center of mass by Newton’s second law: 
F — mb. The total vector moment (torque) about die center of mass is related to die angular velocity and 
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angular acceleration of the body by Ruler’s equation 

N — 7 • u; -f- uj X {l • w). (1.3) 


The Ruler equation follows directly from the laws of rotating reference frames and the following 


definitions: 


w angular velocity 


I 


inertia tensor 


L — I ■ uj 


N 


dt 


angular momentum 
moment (torque). 


These definitions are analogous to those found in the case of linear motion, except that inertia is a second 
rank tensor instead of a scalar, since angular momentum is not in general parallel to angular velocity. If we 


use d*/dt to indicate differentiation with respect to the rotating reference frame, we then have: 


N 


dL d*L 


dt 


& 


4 - to X L 


d 


dt 


(£•«) + « x (£•«) 


= L • « + w x (I • w). 


To apply the Newton-Ruler equations to a kinematic chain, the following procedure may be used. 

1. The base of the chain is either fixed or its motion is known. Starting from the base and working 
outwards, and using the known geometry of the chain, v,-, and uij of link i may be found in 
terms of the q p qj, and q 3 of the proceeding joints. 

2. The total vector force Fj and the total vector moment Ni acting on each link may now be 
determined using the Newton/Ruler equations. 

3. The total force computed in step 2 is the vector sum of the forces exerted on the link by its 
neighbors at the joints, and the force of gravity. The total moment is the vector sum of the pure 
moments exerted on the link by its neighbors, and the moments generated by the forces exerted 
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by its neighbors. Thus if the force and moment acting at one end of a link are known, we can 
use the totals from step 2 and the known force of gravity to solve for the force and moment 
acting at the other end. These arc equal and opposite to the force and moment exerted by the 


given link on its neighbor, by Newton’s third law. Thus, if the force and moment exerted by the 
environment on the terminal link (e.g. the hand) are known, we can proceed down the chain to 


the base and determine the force and moment acting at each joint. 


4. For rotational joints, die vector moment determined in step 3 is projected along the axis of 
rotation to yield the joint torque. For sliding joints, the vector force from step 3 is projected 
along the sliding axis to yield the joint force. The other components of the force and moment 
are generated.by the structure and bearings of the device. 


It is clear that many details must be filled in before the above procedure can actually be applied to a 


kinematic chain. We must have conventions for defining die geometry of the chain and specifying how the 
joint variables arc to be measured, and coordinate systems that allow the vector and tensor quantities to 
be specified. The transformation required by step 1 must be worked out, and the operations specified by 
the other steps must be written down in detail. The efficiency of the resulting computation will depend on 
how diese issues are resolved. 

Recently a number of authors have been interested in the Newton-Euler approach, partly due to 

perceived problems with the Lagrangian formulation, as mentioned above. Stepanenko and Vukobratovic 

* 

[6] worked out the details in connection with work on understanding the dynamics of human limbs. One 
of their main goals was to develop a computer program that could perform the tedious mathematical 
manipulations necessary to set up the equations of motion from a description of the kinematic chain. 
They rejected the Lagrange equation because of the differentiations it requires—diere are severe problems 


associated with numerical differentiation, as they pointed out. These problems can be avoided, however, 
by deriving die differential equation of motion for an arbitrary kinematic chain, as is done in section 3 
for the open-loop class. Numerical values for a specific device arc then substituted, but at this point all of 
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the necessary differentiations have been done symbolically. The general solution can readily be found by 
hand, and only needs to be done once. 

Stepanenko and Vukobratovic were not concerned with the efficiency of die computation. Their 
formulation was revised by Orin el al. [7] in connection with the control of robot legs. They improved 
upon the efficiency of Stepanenko and Vukobratovic by referring the forces and moments to coordinate 
systems attached to tire links instead of fixed coordinates. They also noticed that the sequential nature 
of the computation (iterating from the base to die tip to determine the motion of the chain, and then 
from the tip to the base to determine die forces, as described above) seemed to reduce the computation 
time and storage requirements. They speculated that such a recursive procedure might be more efficient 
in general, but did not draw any conclusions. Armstrong [8] and I.uh et al. [4] paid close attention to com¬ 
putational efficiency and confirmed these suspicions. They pointed out that the Newton-F.uler formulation 
leads to an algorithm where the computation time grows linearly with the number of links, as opposed 
to die quartic behaviour of the original Lagrangian formulation. They further improved die efficiency by 
referring the linear and angular velocities and accelerations, as well as die forces and moments, to link 
coordinates. In addition, the need for efficiency produced a formulation which is simpler in many ways. 
For example, the three coordinate systems attached to each link by Stepanenko and Vukobratovic were 
replaced by one. 

1.4 Recursive Lagrangian Dynamics 

Hollerbach [3] realized that the recursive nature of die Newton-Euler formulation that made it so 
efficient could be achieved with the Lagrangian formulation as well. Starting with the original results of 
(dicker and Kahn, he developed forward and backward recurrence relations for die terms in (1.2) that al¬ 
low the generalized forces to be computed in linear time. The result for a 6-link manipulator still required 
about 5 times die number of adds and multiplies as the I.uh formulation, but this is about 15 times better 
than direct evaluation of (1.2). 
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Hollerbach also realized that the use of 4 X 4 rotation/translation matricics to represent the position 


and motion of the chain led to inefficiencies in the calculation. He reformulated tire Lagrangian dynamics 
in terms of pure rotation matricics to specify the orientation of the links, and displacement vectors to 
specify their position. This reformulation resulted in an additional factor of 2 savings in adds and mul¬ 
tiplies, bringing the Lagrangian formulation to within roughly a factor of of Lull’s Newton-Euler 
formulation. 


1.5 The Importance of the Representation of Angular Velocity 


Hollerbach used a rotation matrix Wj to specify the orientation of link i of the kinematic chain. Wi 
transforms tine components of a vector with respect to a coordinate system fixed in link i to its components 
with respect to a fixed (inertial) coordinate system. The angular motion of link i is represented by the time 


derivatives of W): Wi and W{. 

t « • 

Although Wi, Wi, and W t each have nine components, orientation has only three degrees of 
freedom and thus only three of tine components are independent. An equivalent representation for the 
angular motion of a link is the angular velocity vector w* and the angular acceleration vector w*, which 
have been used in all of the Newton-Euler formulations reported here, and which contain no redundant 
information. Unfortunately, there in no “orientation vector” corresponding to Wi, die Euler angles or 
equivalent may be used instead, although we will not need to do so here. 


In the next section we explore in detail the relationship between w and W, and the resulting descrip¬ 
tions of rotational dynamics. In the following section we show that a Lagrangian formulation based on 
w instead of W leads to exactly the same computation as the Newton-Euler formulation. This result is 
hardly surprising, since both methods must give the same numerical solution, and we are now starting 
with exactly the same quantities. The significance of this result is not just that it doesn’t matter which 
formulation one uses. Rather, it shows what the real issues are if one is interested in efficiency: structure of 
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the computation and choice of representation. 






2. Comparison of Rotational Dynamics with w and W 


ft was pointed out above that the angular motion of a rigid body could be described equally well by cither 
the angular velocity vector u> or the derivative of a rotation matrix, W. Obviously, scalar quantities such as 
kinetic energy must be independent of the representation chosen, but higher rank tensor quantities need 
not be, and expressions for any quantity will be different in form. Furthermore, neither representation is 
clearly better in all cases. Use of w may yield a more efficient computation, but it has the disadvantage that 
there is no “angular position vector” that it is the derivative of. Therefore, it is interesting and useful to 
compare the description of rotational dynamics that results from different choices of representation, and 
to develop formulas that allow one to switch between representations. That is the main purpose of this 
section, although in making this comparison we will also get expressions for rotational inertia and kinetic 
energy which arc needed in the next section. 


2.1 W 

We start by defining W more formally and introducing some conventions that arc needed below. 
We assume that die reader is familiar with the properties of the angular velocity vector u) and rotating 
reference frames, which have been discussed in many texts (see, for example, [5]). 

Let {e\, e 2 , e 3 } be any fixed (inertial) orthonormal basis, and let (e), e! 2 , e^} be any orthonormal basis 
attached to a rotating rigid body. We will always use primes to indicate rotating basis vectors or the 
components of a vector with respect to such a basis. Thus, if v is any vector we have: 
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From now on we will drop the summation sign and use the Einstein summation convention, that is, 
indices that appear twice in any term imply a summation of that term over all values of the indices (i.e. 
{ 1 , 2 , 3 }). 

Using the above conventions we can write: 


v = v 


yj 


A 

v • e,- 


i 


v L 


A A, ( 

e i ’ e j V j 


Witf, W * 


Wi 


dW, 




ij 


dt 




A A r 

ei ' <• 


( 2 . 1 ) 


Note also that since the in verse of W is its transpose, we have: 


r 


w ik w kj 


W ik w jk - Sij, 


where Sij are the components of the identity tensor 



2.2 The Cross Product Operation 


Wc must now briefly discuss the cross-product operation, which is indispensible when dealing with 
rotation in three dimensions, and which must be used unambiguously with second rank tensors as well as 
vectors. We assume that the standard geometric definition of the cross product of two vectors is known to 
the reader. 

The cross product may be viewed as a function of two vectors that produces a third vector: 


a X b — c — P(a, b). 

Alternatively, we may view the cross product as a function of three vectors that produces a scalar, the so- 
called scalar triple product: 
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The function P is: 

• Linear in a, b, and c. 

• Independent of the choice of basis vectors (since it is defined geometrically). 

Therefore, P is a rank three tensor 1 . 

To find the components of P according to some right-handed basis {£[, £ 3 }, we simply apply the 

function to the basis vectors: 



A 

= Ci 

/ 


= < 

k 


v A A 

X €j * Cfc 

1 , if ijk is an even permutation of 123, 

—1, if ijk is an odd permutation of 123, 
0 , otherwise. 


From this it can be seen that P is totally anti-symmetric—-swapping any two indices changes the sign (but 
rotating the indices has no effect). To illustrate how P is used, here are the formulas for the cross-product 
of two vectors, and the scalar triple product, in coordinates: 


tS X Jj\i - P{jk^j^k &* Jl, ^ fi PijkQ'ibjCk* 


There are two very useful identities associated with the components of P: 


PijkPiji = 24/, (2.3) 


and 

PijkPilm :==: 3jl$km fijmfikb ( 2 . 4 ) 


^Technically, a pseudotensor , since it requires consistent use of right- or left-handed coordinate systems, but not both. 
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2.3 The Relationship Between lo and W 

We can now find the explicit relationship between u and W. That relationship will be seen to be 

position (i.c. orientation) dependent, and the position will always be represented by the rotation matrix 
W. 

Let v be any vector rotating w ith angular velocity w. We can derive die components of v in the 
following two ways: 

P &== « x V 2) Vi= Wijv'j 

Vi = Pikl^kVl Vi— Wijv'j 

Equating the two gives: 

Wijv'j = PikioJkVi = PikMcW,ji/j. 

Since this must hold for any v, it is clear that 

PikltVfcWlj ( 2 . 5 ) 

(or in vector notation, W — w x W). The inverse relation may be found from this and equations (2.2) 
and (2.3) as follows: 

Wij — PiutoWu 

i j ^ikl^k^lrn ^ikrn^k 

» 

PinrnW m jj Pik mPi. n rnk^h ' = ~ z==== 2cV ?1 . 

Making an appropriate change of dummy indices, we get 

= \PijkWji\Yki, ( 2 . 6 ) 

to which there is no corresponding vector notation known to the author. 


2.4 Rotational Inertia and Kinetic Energy 


This section has three purposes: it gives one example of how a dynamic quantity (rotational kinetic 
energy) can be expressed in terms of either w or W, it provides one way of defining tire inertia tensor (the 
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definition will depend on whether a? or W is used), and it provides die expression for rotational kinetic 
energy that is needed for the I.agrangian formulation of the next section. 


Let r be a vector from the center of mass of a rigid body to a small volume element of mass dm. The 
velocity and kinetic energy of the volume element (due to rotation of the body) can be written as: 


v = r 

(IK = • vclm. 


We will express dK in terms of both W and lo and integrate over the body to get die total rotational 
kinetic energy. The definitions of the inertia tensor will fall out of the derivation. Components of vectors 
are with respect to any right-handed orthonormal basis, primed for rotating and unprimed for fixed, as 
above. First, using W: 


r; 




let 


Vi 

dK 

K 


K 


w ■ y. 

yy ifj 


ttW ij r' j )(W ik r' k )dm 

hWijWik [//.dm 


v 


r'.r' k dm 


hW ir J' 3k Wi k 

\tv{WJ'W r ). 


( 2 . 7 ) 

(2.8) 


The last expression is in 


matrix form for the benifit of readers who are more familiar with that notation. 


Now we repeat the derivation, using lo instead: 
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l! = SXf 

dK = X r) ■ (w X rjrfm 

~ ^ [(a; • a;)(r • r) — (uj • r)(tu • r)]dm 
= ^ [a liWir 1 — LOir^jr^dm 
= }j [uJiLOjSijr 1 — wga/yrjjdm 


= ^0JiU)j(r 2 8i j — rj^drn 



K = faWjlij = 


(2.9) 

( 2 . 10 ) 


From equations (2.7) and (2.9) the relationship between the two inertia tensors can be seen: 


L = trim - L 


J = Ur(I)6-I. 


( 2 . 11 ) 


Note that since / and J have been defined above by their components, they have not actually been shown 
to be tensors. The proof is simple and can be supplied by tire reader. 

» 

i 

From equations (2.8) and (2.10), and a definition of a generalized coordinate q, the rotational con¬ 


tribution to the corresponding generalized force can be found from the Lagrange equation. This was 
done by Hollcrbach [3] for W, and is done in the next section for up We summarize the results here for 


comparison: 


* 

angular 

velocity 

UJ 

W 

kinetic 

energy 

buj * I ' to 
£ 

±tr{WJW T ) 

generalized 

force 

JX , 

fe • L + w x (/ • w)] • 

~ ~ oq 



While these expressions have been derived independently, their equality can be verified by direct substitu¬ 


tion using equations (2.4), (2.5), (2.6), and (2.11). 









3. Lagrangian Dynamics Using u> Instead of W 


In this section we give the details of the I.agrangian formulation based on the angular velocity vector w. 
The generalized forces are derived for any open-loop kinematic chain, and the results are interpreted and 
compared to the Ncwton-Euler formulation of I.uh [4]. 

One feature that distinguishes the present formulation from previous ones is that expressions for the 
generalized forces are derived without defining a single coordinate system. All quantities are expressed in 
terms of geometric objects (tensors) and geometric operations (vector addition, dot and cross product). It 
is only at the end, when a computation must be derived from these expressions, that coordinate systems 
must be defined, so that the various quantities can be measured and represented in a computer program. 
At tliis point, expressions may be evaluated in any convenient right-handed orthonormal coordinate sys¬ 
tem, provided that this is done so in a consistent manner. In practice, the method presented by Lull [4] is 
probably most efficient. 


3.1 The Derivation of the Generalized Forces 

In this section we write down the total kinetic energy of a kinematic chain and apply the Lagrange 
equation to derive the generalized forces. The potential energy term due to gravity is omitted here as 
mentioned in section 1.2, although this and other minor details arc taken care of below. 

The total kinetic energy of a rigid body is the sum of the energy due to the motion of the center of 
mass and the energy due to rotation about the center of mass [5]: 
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To get the total energy of a chain, sum over all of the links: 


E 2 m ife) 2 H - jWj 'Li' T 


i=l 


We may now compute the derivatives required by the Lagrange equation (1.1). 


(3.1) 


dK 

<% 


E d V{ . dui i 

m-iVi ■ ~ + Ui- Li' 

. dqj ~ dqj 


(3.2) 


The first term of (3.2) follows directly from the chain rule. For the second term, note that while the 
inertia tensor J; is a function of position, it is independent of any joint velocity qj. Furthermore, since / is 
symmetric, 


I. r. ... _ 1., r 
dqj ^ ~ dqj • 


Straightforward application of the rules for differentiating products gives: 


d / <9K 
d 1 1 dqj 


E 


<3iU . d / <5?;v 

rrijVi • 4- rrtiVi • —I — 

" c% dt\dqj 


[ U)l • Ii * “— ~j— * I{ * - — tcJ* * Ij ’ —f — 

- - dqj ' ~ l dH<% 


(3.3) 


It is shown in Appendix A tliat: 




d ( dv{ 
dt \ dq j 


• diOi 
cu { * I i • - 1 - 
~ a<7j 


d / c% 

dil dq j 

t ( 

Q i ' Li * I 4 f X ~ 
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Substituting (3.4)-(3.7) into (3.3) gives: 


d (dK 
dt 1 dq 


j 


£ 


i L 


• <% 

miHi' 7TT- + rriiV, 


dq 


dvj 

dq. 


4 " ^Zi ' Li 


dujj 

dq, 


4 Qi ■ L 


duii 
dqi 


( 3 . 8 ) 


Now for the final term in the Lagrange equation: 


dK_ 
dq<j 


-E 


^ L 


dvi duj( 

miVi ■ + Vi ' h ■ - 7 T- 


dq■ 


dq 


4- jy* 


dl, 


J 


dq 


UJi 


j 


( 3 . 9 ) 


This is very similar to (3.2), except for the appcarcnce of a term due to the position dependence of tire 
inertia tensor. It is shown in Appendix A that: 


UJ. 


% 

dq. 


a 


/ T A du) i 
-w. X tli ■ UJi) ■ ~ 

dqj 


( 3 . 10 ) 


Putting it all together: 


r i 


d dK 


dt \ dq. 


dK_ 
dqi 


T. ( m iLi ■ 4- [a?t • Li + x (Li ■ w;)] • 


( 3 . 11 ) 


3.2 Comparison with the Newton-Euler Formulation 

# 

We have derived die generalized forces in a very general way, without unnecessary details like 
coordinate systems, link and joint numbering conventions, and other conventions needed to specify the 
geometry of the manipulator. In order to interpret die result and compare it to the Newton-Euler formula¬ 
tion, however, it is finally necessary to make some of these definitions. Such details arc not the point of 
this paper, and will be kept to a minimum. 

The links of the manipulator arc numbered consecutively from the base to the tip, as are the joints 
that connect them. The base is considered to be link 0, while the terminal link is numbered link n. The 







Figure 3.1. Link and joint numbering, and other conventions for open-loop kinematic chains. 


/*> 


joints arc numbered 1 thru n, joint 1 connecting link 1 to the base. Thus joint i connects links i — 1 and 
i; link i is bounded by joints i and i -j- 1, as shown in figure 3.1. 

If joint i is rotational, the joint variable qt measures the angle of rotation from some (arbitrary for the 
present discussion) reference point; if it is translational, measures the sliding distance. The unit vector 
Zi is attached to joint i and points along the axis of rotation for rotary joints or along the sliding axis for 
sliding joints. Note that for rotary joints, q t must be measured in a right-hand sense about Z{. Finally, let 
Pj t i be a position vector that points from anywhere along the axis of joint j to the center of mass of link 
i. (Note: These definitions of 2; and p Jtl arc non-standard, and arc clearly too ambiguous to be used in 
practice. They are, however, all that is needed to understand equation (3.11)). 

One of the first things one notices when looking at equation (3.11) is that it contains the Newton- 
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Kuler expressions for the total vector force and moment acting on a rigid body. In fact we can rewrite 


(3.11) as: 




(3.12) 


Thus we are very interested in die vectors <%/<% and dwjdqj that the force F t and moment Ni are 
projected onto. These vectors specify the dependence of the linear and angular velocity of link i on the 
joint velocity of joint j. For j > i there is no such dependence, and so these vectors arc 0. This means 
that the summation in equation (3.12) can be taken from i — j to i — n, instead of over all i. 

For j < i, we note that the linear and angular motion of link i may be written as the vector sum of 
contributions due to the relative motion of the previous links at the joints: 


Lj 


( qjZj) X Pj,i, if joint j is rotational; 


i=t I qjZj, 


if joint y is translational. 


(3.13) 


-.=Er 

J-I 0, 


qjZj, if joint j is rotational; 


if joint j is translational. 


(3.14) 


Differentiating gives: 


dv \ z 3 X Pj,u if joint j is rotational; 


dqj 


if joint j is translational. 


(3.15) 


dwi 

dqj 


if joint j is rotational; 
if joint j is translational. 


(3.16) 


Ifjoint j is translational, the joint force can now be written: 


T 3 = = Z 3 


•r-i 

E f <- 


t=j 






William M. Silver 


22 


I.agrangian Dynamics Using u> Instead of W 


If joint j is rotary, the torque is: 


n 


T a 


% • x Fj + Ni). 


i=3 






Thus, to compute the generalized forces we first iterate from the base to the tip to compute Vi, w,-, and w;, 
and then iterate from the tip to the base using the above relations to compute the forces. Referring to [4], it 
can be seen that this is exactly the computation specified by Luh that was derived from the Newton-Euler 
approach. 

A few minor points still need to be cleared up, however. First, we are still free to choose a coordinate 
system or systems in which to evaluate these expressions. The method presented in [4] is probably best, 
where quantities associated with a given link (such as tire inertia tensor) are expressed in a coordinate 
system attached to that link, and then arc transformed to tine coordinates of the previous link as the 
iteration proceeds. 

Second, we must say something about the gravity term which we have thus far ignored. We could 
include it in the Lagrange equation in die standard way, as a position dependent potential energy term. 
This is equivalent to its inclusion in the Newton-Euler formulation as described in step 3 of section 1.3. 
Perhaps a better way was also discussed by Luh—instead of considering the base as fixed, give it a vector 
acceleration equal to that due to gravity. Both methods will give the same numerical result, but Lull’s is 
probably more efficient since the effect of gravity is computed only once. 

Third is the sliding friction forces produced in the joints that Luh includes in his equations. These, 
however, arc simply computed based on the joint velocity and are added directly to the joint generalized 
force. This clearly can be done no matter how the dynamics are formulated. 

Finally, the Newton-Euler dynamics includes the solution to the problem of the statics of the 
manipulator, that is tine effect of the external force and moment acting on the terminal link. This can 
be included in tine Lagrangian formulation by supposing an additional link attached to the terminal link, 
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Lagrangian Dynamics Using u> Instead of W 


whose motion is defined so as to produce the required external forces. This is very much like including 
gravity by specifying the acceleration of the base rather than the equivalent forces. 






A. Details for the Lagrangian Formulation 


% 


In this Appendix wc supply the details that were omitted from the derivation of the generalized forces 
presented in section 2.1. 


For equation (3.4), let r,- be a position vector from any fixed origin to the center of mass of link i, so 


that Vi = f ( . Then we have: 




cl_ 

dt 






Equation (3.5): 


Equation (3.7): 


4 Li ' 


dto, 
dq j 


' (stA X Li Li X Wj) 


% 

d <h 


, w r % du) i . . du){ 

t±!i ' x 7i) • Tqr ' (Li X 


Wi X 4• Li 4 ~ 


<% 
<9w; 


<9g. 


foi ’ Xi) X Wj 


<% 

du); 

rxj *• 


X (Ij ■ Wj) • —- 

dq; 


i * I i W 'i X 


dug 


* Jji) X 


dto- 


dq 


j 


'*£i X (Ij * ’ TjT - * 
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Details for the Lagrangian Formulation 


For equation (3.10): Following a procedure similar to that used in (A.l) above, it can be shown that: 

dli d/j 
________ 

dqj ~ <%' 


lius we have: 


dlicrefore, 


2*h 


dh 


r.. (tih' X Ji Ji X CUj) 

oqj ~ ~ 


dtOi 

wr 1 xli 
dqj = 


r doji 

Li X ^r 1 . 

dqj 


2 q>j 


du)i r 

# x Li 

dqj ~ 


5 «i 


Xi x XF 1 

dqj 


duji 

dqj 


ku-W* Hi • 


1 / r A 9U){ 

2 fez ’ /i) x ~ * W, 


’ x (F •«») ■ — £«* x (/,■ • Wi) • 

C/Qj ^ j 

■yz x (fz * * ——. 

dqj 


The final (and trickiest) proof is equation (3.6): 


d I dui i 
ft 1 dqj 


dtOi . dtOi 

“IfeX 

dqj dqj 


We will need equations (3.14) and (3.16), and tlie conventions of section 3.2 (see figure 3.1), except that for 
convenience we will take to be 0 if joint k is translational. 

First note that if joint j is translational, or if j > i, w, is independent of both qj and q jt so that both 
sides of the equation are identically zero. Now for j < i, since Zj is attached to joint j and therefore link 


j, we may write: 


d ( duii 
dt \ dqj 


~j X z j- 


(A.2) 


By considering the rotation of a vector by some angle about a given axis, it can be seen that: 
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Details for the Iagrangian Formulation 


Now we have everything we need for tire proof. Starting with (A.2), 


d I did 


dt \ dq 


!Aj X z j 


j 


(«.- E *A)x$ ; 


&— 


u; 


.■ X % + E * A X 


A 


? <3* 

v/ A i • ® z k 

^ x z i + E 


jt=i 


, . , A d V—> . A 

uJi x Zj -f- — 2_J (IkZk 

* 3 //* 


fc= 1 


<9w,- , <9Lt»f 
«.• X ^ 

% <% 
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